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Abstract  We  consider  the  problem  of  computing  a  time-optimal  motion  for  two  robots 
carrying  a  ladder  from  an  initial  position  to  a  final  position  in  a  plane  without  obstacles. 
At  any  moment  during  the  motion,  the  distance  between  the  robots  remains  unchanged  and 
the  speed  of  each  robot  must  be  either  a  given  constant  v,  or  0.  A  trivial  lower  bound  on 
time  for  the  robots  to  complete  the  motion  is  the  time  needed  for  the  robot  farther  away 
from  its  destination  to  move  to  the  destination  along  a  straight  line  at  a  constant  speed  of 
V.  This  lower  bound  may  or  may  not  be  achievable,  however,  since  the  other  robot  may 
not  have  sufficient  time  to  complete  the  necessary  rotation  around  the  first  robot  (that  is 
moving  along  a  straight  line  at  speed  u)  within  the  given  time.  We  first  derive,  by  solving  an 
ordinary  differential  equation,  a  necessary  and  sufficient  condition  under  which  this  lower 
bound  is  achievable.  If  the  condition  is  satisfied,  then  a  time-optimal  motion  of  the  robots  is 
computed  by  solving  another  differential  equation  numerically.  Next,  we  consider  the  case 
when  this  condition  is  not  satisfied,  and  show  that  a  time-optimal  motion  can  be  computed 
by  taking  the  length  of  the  trajectory  of  one  of  the  robots  as  a  functional  and  then  applying 
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Office  of  Naval  Research  under  grant  N00014-94-1-0284,  and  an  endowed  chair  (KIFUKOZA)  supported  by 
Hitachi  Ltd.  at  Faculty  of  Engineering  Science,  Osaka  University. 


the  method  of  variational  calculus.  Several  optimal  paths  that  have  been  computed  using 
the  above  methods  are  presented. 
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1  Introduction 

Suppose  that  two  mobile  robots  are  carrying  a  ladder,  one  at  each  end,  in  the  plane  without 
obstacles.  What  is  the  time-optimal  motion  of  the  robots  from  a  given  initial  position  to  a 
final  position  of  the  ladder,  subject  to  the  given  constraints  on  the  kinematics  of  the  robots, 
such  as  maximum  acceleration  and  velocity?  Note  that  the  ladder  enforces  the  distance 
between  the  robots  to  remain  unchanged  during  the  motion. 

In  this  paper,  we  present  a  solution  to  the  above  problem  for  the  case  when  the  kinematic 
constraint  of  the  robots  is  simply  the  following:  At  any  moment  during  the  motion,  the 
speed  of  each  robot  is  either  a  given  constant  u,  or  0.  That  is,  each  robot  must  move  at 
speed  V  whenever  it  decides  to  move,  and  it  is  not  allowed  to  move  at  a  nonzero  speed  less 
than  n.  The  work  reported  here  on  this  restricted  case  is  considered  a  step  towards  the  goal 
of  solving  the  general  optimization  problem  stated  in  the  previous  paragraph  under  more 
complex  kinematic  constraints  (and  possibly  in  the  presence  of  obstacles). 

The  difficulty  in  finding  an  optimal  motion  even  for  the  simple  case  considered  here  lies, 
intuitively,  in  ‘‘balancing”  the  trajectories  of  the  two  robots  to  achieve  minimum  time.  For 
example,  suppose  that  robots  A  and  B  must  move  to  and  5^,  respectively,  as  is  shown 
in  Figure  1,  carrying  a  ladder.  (We  use  “A”  and  “5”  to  refer  to  the  robots  as  well  as 
their  initial  positions.)  One  way  to  move  is  to  first  rotate  the  ladder  about  its  center  (the 
midpoint  of  AB)  until  it  is  parallel  to  A^ B\  and  then  translate  it  to  A  5  ,  as  is  shown  in 
Figure  2.  This  is  a  legal  motion,  since  the  distance  between  the  robots  remains  unchanged 
and  the  robots  can  move  at  speed  v  all  the  time.  Another  strategy  would  be  to  do  rotation 
and  translation  simultaneously,  obtaining  a  motion  such  as  the  one  shown  in  Figure  3.  Note 
that  the  path  of  robot  B  is  a  curve,  rather  than  a  straight  line  segment,  indicating  that 
B  “yields”  to  give  just  enough  time  for  A  to  complete  the  necessary  rotation.  In  fact, 
the  motion  shown  in  Figure  3  is  a  time-optimal  motion  obtained  by  the  method  given  in 
Section  3. 


Figure  I:  Robots  A  (empty  circle)  and  B  (filled  circle)  move  to  A'  and  5',  tespectively, 
carrying  a  ladder. 

The  time  optimization  problem  considered  in  this  paper  is  related  to  the  Ulam  problem 
of  optimal  motion  of  a  line  segment  [16].  Proposed  by  S.  M.  Ulam  in  1960,  the  Ulam  problem 
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Figure  2:  A  suboptimal  motion  consisting  of  a  rotation  followed  by  a  translation. 


Figure  3:  Time-optimal  motion  for  the  instance  shown  in  Figure  1.  The  figure  consists 
of  a  series  of  snapshots.  In  the  first  few  shots  the  segment  increases  in  grayscale  as  time 
increases. 
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figure  4:  An  instajice  in  which  the  initial  position  of  robot  A  is  also  its  final  position 
A',  where  LBAB'  =  60°.  The  dashed  line  shows  the  arc  that  B  will  follow  if  A  remains 
stationary. 


asks  for  the  general  solution  for  moving  a  line  segment  to  a  given  position  while  keeping  the 
sum  of  the  lengths  of  the  trajectories  of  the  two  endpoints  minimum.  Gurevich  [8]  gives  a 
solution  to  the  Ulam  problem  using  variational  calculus  and  Euler-Lagrange  equations  [5]. 
A  book  by  Dubovitskij  [3]  studies  the  Ulam  problem  with  the  two  endpoints  moving  on 
prescribed  surfaces  in  an  n-dimensional  space. 

In  general,  the  solution  to  the  Ulam  problem  that  minimizes  the  sum  of  the  trajectories 
differs  from  the  result  of  time  optimization.  Consider  the  instance  shown  in  Figure  4  in 
which  the  initial  position  of  robot  A  is  also  its  final  position.  Our  result  given  in  Section  2 
shows  that  the  time-optimal  motion  for  this  instance  is  the  one  shown  in  Figure  5,  in  which 
robot  B  moves  straight  to  B'  at  speed  v  while  A  makes  a  circular  motion,  with  total  time 
\BB'\/v.  This  motion,  for  which  the  sum  of  the  lengths  of  the  trajectories  of  the  two  robots 
is  2\BB'\,  is  not  optimal  for  the  Ulam  problem,  since  a  simple  rotation  of  the  ladder  about 
A  (without  moving  robot  A),  as  indicated  in  dashed  line  in  Figure  4,  gives  a  sum  that  equals 
the  length  of  the  arc  from  B  to  B',  which  is  smaller  than  2|5J3'|. 

There  are  other  problems  related  to  ours.  Feinberg  and  Papadimitriou  [4]  consider  the 
problem  of  finding  possible  paths  for  moving  two  points  that  must  always  remain  a  fixed 
distance  apart,  from  initial  to  final  positions  among  polygonal  obstacles.  Goodman,  Pach 
and  Yap  [6]  study  the  problem  of  deciding  whether  two  painters  carrying  a  ladder  can  stay 
on  a  specific  path.  These  works  consider  the  ladder  moving  problem  in  the  plane  in  the 
presence  of  obstacles,  with  an  emphasis  on  proving  the  feasibility  of  the  constraint  motion. 
In  contrast,  in  our  problem  the  robots  are  free  to  move  in  the  entire  plane,  where  feasibility 
is  not  a  concern.  Our  goal  is  to  select  a  time-optimal  path  from  an  infinite  number  of 
possible  paths  under  the  given  velocity  constraint.  Naturally,  the  study  of  time-optimal 
motion  in  the  presence  of  obstacles  will  not  be  possible  without  the  understanding  of  our 
simpler  problem.  Another  related  work  is  by  Mitchell  and  Wynters  [10],  who  consider  the 
motion  of  two  covisible  points  (that  need  not  remain  a  fixed  distance  apart)  in  the  plane 
containing  obstacles,  that  minimizes  the  sum  of  the  leiigths  of  the  trajectories  of  the  points, 
or  the  length  of  the  longer  trajectory.  They  also  consider  the  problem  of  minimizing  the 


Figure  5:  Time-optimal  motion  for  the  instance  shown  in  Figure  4. 

time  of  the  motion  of  covisible  points  assuming  a  common  upper  bound  on  their  velocity. 
Their  assumption  that  the  two  points  need  only  remain  covisible  gives  a  useful  combinatorial 
structure  that  one  can  exploit  in  finding  a  desired  optimal  motion.  Our  assumption  that 
the  robots  must  remain  a  fixed  distance  apart,  on  the  other  hand,  does  not  seem  to  yield 
such  a  property. 

Other  problems  related  to  ours  in  a  broader  sense  include  formation  and  maintenance  of 
geometric  patterns  by  mobile  robots  in  the  plane,  studied  in  the  area  of  multiple  distributed 
robot  systems,  where  it  is  typically  assumed  that  the  robots  are  autonomous  agents  that 
make  decisions  individually  using  only  local  information  available  to  them.  We  refer  the 
reader  to  Sugihara  and  Suzuki  [13],  Suzuki  and  Yamashita  [14,  15],  and  Chen  and  Luh  [1] 
for  discussions  on  formation  and  related  agreement  problems,  Kawauchi,  Inaba  and  Fukuda 
{9]  for  discussions  on  mobile  cells  carrying  an  object  coordinatedly,  and  Parker  [11]  for  the 
issue  of  balancing  local  and  global  control  on  maintaining  a  formation  of  a  group  of  four 
robots. 

A  trivial  lower  bound  on  the  time  needed  to  move  the  ladder  in  an  instance  such  as 
the  one  given  in  Figure  1  is  |55'l/u,  assuming  \BB'\  >  \AA'l  which  is  achievable  when  A 
completes  the  necessary  rotation  while  B  moves  straight  to  at  speed  v.  This  lower  bound 
may  or  may  not  be  achievable,  however,  since  A  may  not  have  sufficient  time  to  complete  the 
necessary  rotation  around  B  within  time  \BB^\/v.  So  first  in  Section  2,  we  derive,  by  solving 
an  ordinary  differential  equation,  a  necessary  and  sufficient  condition  for  this  lower  bound 
to  be  achievable.  The  condition  is  expressed  in  terms  of  the  length  \BB^\  and  the  angles  that 
AA'  and  BB'  make  with  the  line  passing  through  B  and  B\  If  the  condition  is  satisfied, 
then  the  desired  optimal  motion  can  be  computed  by  solving  another  differential  equation 
numerically.  Next  in  Section  3,  we  derive  a  method  for  computing  a  time-optimal  path  when 
the  condition  is  not  satisfied,  by  taking  the  length  of  the  trajectory  of  one  of  the  robots 
as  a  functional  and  then  applying  variational  calculus  and  Euler-Lagrange  equations  [5], 
techniques  used  by  Gurevich  in  [8]  to  solve  the  Ulam  problem.  When  applying  the  method, 
we  first  solve  a  set  of  equations  involving  the  Legendre  eUiptic  integrals  [7],  and  then  use 
the  solutions  obtained  to  numerically  solve  a  set  of  differential  equations  that  describe  the 
motion  of  the  robots.  Time-optimal  motions  obtained  using  the  results  outlined  above  for 
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Figure  6:  L,  a  and  (3. 


several  instances  of  tlie  problem  are  also  presented.  Conclusions  are  found  in  Section  4. 


2  Achieving  a  Lower  Bound 

2.1  A  Lower  Bound 

Without  loss  of  generality  assume  that  \BB'\  >  \AA'\,  as  is  shown  in  Figure  6.  For  con¬ 
venience,  we  take  AB  to  be  of  unit  length  (1^451  =  1),  and  let  L  =  be  the  distance 
between  B  and  B' .  Since  the  robots  can  move  only  at  speed  v  or  0  at  any  moment,  a  lower 
bound  on  the  time  it  takes  to  move  AB  to  A'B'  is 

Lfv. 

Intuitively,  this  lower  bound  is  achievable  if  A  can  complete  the  necessary  rotation  around 
B  within  time  Ljv  while  B  moves  straight  to  B'  at  speed  v.  The  main  result  of  this  section 
is  a  necessary  and  sufficient  condition  for  this  to  be  possible. 

Let  R  be  the  line  passing  through  B  and  B' .  Let  a  be  the  angle  between  AB  and  R, 
and  (3  the  angle  between  A'B'  and  R,  as  is  shown  in  Figure  6.  Without  loss  of  generality, 
we  assume  0  <  a  <  180°  and  —180°  <  /?  ^  180°. 

The  following  lemma  states  that  A  cannot  cross  R  if  the  bound  Ljv  is  to  be  achieved. 

Lemma  1  Suppose  that  B  moves  straight  to  B'  at  speed  v  and  reaches  B'  at  time  Ljv. 
Then  during  the  time  interval  [Q^Ljv],  either  A  always  lies  on  R,  or  A  never  lies  on  R. 

Proof  We  only  give  an  outline  and  leave  a  formal  proof  to  the  reader.  We  can  view 
the  velocity  of  robot  A  as  composed  of  two  parts.  The  first  part  comes  from  translational 
motion,  and  is  equal  to  the  velocity  of  B  with  magnitude  v.  The  second  part  is  the  rotational 
contribution.  When  A  lies  on  R,  the  rotational  part  is  perpendicular  to  the  translational 
part,  and  unless  the  former  is  zero  the  value  of  the  net  velocity  wiU  exceed  v.  Therefore 
once  A  lies  on  R,  it  is  not  possible  for  A  to  rotate  around  B  and  leave  R.  For  a  similar 
reason,  it  is  not  possible  for  A  to  move  to  a  point  on  R  unless  it  is  already  on  R.  □ 
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Lemma  1  implies  that  AB  can  reach  MB'  within  time  L/v  only  if  a  =  /3  =  0°,  a  =  /?  = 
180°,  or  A  and  M  are  on  the  same  side  of  R  (i.e.,  0  <  o:,/3  <  180°).  Since  AB  can  simply  be 
translated  to  MB'  in  time  L/n  whenever  a  =  /?,  in  the  following  we  only  need  to  examine 
the  case  0  <  a,/3  <  180°  and  a  ^  p.  In  this  case,  the  assumption  \BB'\  >  \AM\  implies 
0<a<l3<  180°. 

It  is  convenient  to  view  the  motion  in  the  coordinate  system  that  moves  with  B  at  speed 
V.  In  this  coordinate  system,  A  can  only  rotate  around  B  because  |i45|(=  1)  is  a  constant. 
Let  us  denote  by  9  the  angle  between  segment  AB  and  R  that  changes  with  time,  where 
a  <9  <  13.  Of  course,  ^  =  a  at  time  0,  and  ^  =  /3  at  the  end  of  a  successful  motion. 

If  we  denote  by  u)  the  angular  speed  of  A,  then  the  linear  speed  of  A  due  to  rotation  has 
the  value  u>  since  |.dJ9|  =  1.  Since  A  also  translates  with  B  at  speed  v,  the  actual  velocity 
of  A  in  the  laboratory  coordinate  system  is  the  vector  sum  of  the  velocity  due  to  rotation 
around  B  and  the  velocity  due  to  translation  with  B.  Writing  the  magnitude  of  this  net 
velocity  as  V,  we  have 


—  2ucj  sin  0.  (1) 

Equation  1  is  obtained  by  using  the  fact  that  the  angle  between  the  two  component  velocities 
is  0  +  90°.  Since  both  robots  move  at  speed  v,  we  have 

y  =  u.  (2) 


From  Eq.  1  and  Eq.  2  we  obtain 

Qj  =  2v  sin  9 

which  specifies  the  angular  speed  of  A  around  B.  Since  w  is  the  angular  speed, 

d9 

u  =  — . 
dt 


(3) 

(4) 


Combining  Eq.  3  and  Eq.  4,  we  obtain  the  differential  equation 

^  =  2usin  9  (5) 

dt 

which  specifies  how  angle  6  changes  with  time.  With  the  translational  motion  with  B  taken 
into  account,  this  differential  equation  specifies  the  trajectory  of  A  before  6  completes  the 
change  from  a  to  f3. 

The  differential  equation  can  be  solved  by  direct  integration,  such  that 

/  /  2vdt.  (6) 

Ja  sin0  Jo 

Using  the  formula 

I  -i^d9  =  ln[tan((9/2)]  (7) 

J  sin  0 

we  have 

2uf  =  lQ[tan(/?/2)]  —  Ia[tan(o'/2)].  (8) 

Equation  8  gives  the  time  t  required  for  9  to  change  from  a  to  /?. 
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(9) 


To  complete  the  motion  within  time  Ljv^ 

t  <  Ljv 


must  hold.  Thus  from  Eq.  8 

In  [tan(^/2)]  —  In  [tan(Q!/2)]  <  2L.  (10) 

Eq.  10  can  also  be  written  as 

tan(/3/2)  <  tan(a/2)e^'^.  (11) 

Eq.  11  is  the  basic  result  of  this  section.  For  AB  to  move  to  A'B'  in  time  Ljv,  where 
\AB\  =  1  and  T  =  \BB'\,  pgles  a  and  /?  must  satisfy  the  relation  given  by  Eq.  11.  The 
result  implies  that  the  difference  in  inclination  of  AB  and  A'B'  as  represented  by  the  ratio 
of  tan(/3/2)  and  tan(Q:/2)  cannot  be  overly  large.  Otherwise,  robot  A  will  not  have  enough 
time  to  complete  its  rotation.  The  time  available  to  robot  A  to  change  angle  0  from  a  to  /3 
is  determined  by  L,  the  distance  between  B  and  B' . 

Summarizing  the  discussion  given  above,  we  obtain  the  following  theorem. 

Theorem  1  AB  can  he  moved  to  A' B'  in  optimal  time  Lj v  if  and  only  if  eithev 

1.  a  =  or 

2.  0  <  a  <  P  <  180°  and  tan(/l/2)  <  tan(a/2)e^'^, 
where  L,  a  and  /3  are  as  defined  above. 

2.2  Examples 

We  present  examples  to  illustrate  the  method  given  in  Subsection  2.1. 

Given  i,  a  and  /3,  we  first  test  if  they  satisfy  Eq.  11.  If  Eq.  11  is  satisfied,  then  we  move 
robot  B  to  B'  along  a  straight  line  at  speed  v.  The  movement  of  A  is  a  little  complicated. 
When  a  <  6  <  P,  "we  use  Eq.  5  to  find  the  angular  speed  of  A  around  B,  and  calculate  the 
net  velocity  of  A  by  combining  its  rotational  motion  around  B  and  the  translational  motion 
with  B.  When  angle  9  reaches  /?,  A  stops  rotating  around  B,  and  moves  towards  A'  along 
a  straight  line. 

Figure  7  shows  the  movement  obtained  by  this  method  for  the  case  L  —  2,  a  —  10°  and 
P  =  140°.  The  inequality  (tan(;S/2)  <  tan(a/2)e2^)  in  Eq.  11  holds  in  this  case.  Indeed,  in 
the  figure  we  observe  that  robot  B  moves  along  a  straight  line,  and  robot  A  moves  along  a 
curve  first,  and  then  along  a  straight  line  once  angle  9  reaches  P  (i.e.,  the  ladder  becomes 
parallel  to  A'B').  So  robot  A  has  more  than  enough  time  to  complete  the  required  angle 
change. 

The  next  example,  shown  in  Figure  8,  is  constructed  by  increasing  the  value  of  P  to 
156.35°  while  keeping  parameters  a  and  L  from  the  previous  example  unchanged.  This  is  a 
critical  ca.se  of  the  applicability  of  the  method,  since  the  equality  (tan(/3/2)  =  tan(a/2)e^^) 
in  Eq.  11  holds.  This  means  that  robot  A  has  just  enough  time  to  complete  the  required 
rotation  to  arrive  at  the  destination.  Indeed,  the  figure  shows  that  robots  A  and  B  reach 
their  respective  destinations  simultaneously. 

Finally,  Figure  9  shows  the  case  when  p  has  been  increa.sed  further  to  170°.  Eq.  11  no 
longer  holds,  and  thus  robot  A  has  not  reached  its  destination  when  B  finishes  its  move 
towards  B'. 
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Figure  7:  Segment  AB  moves  to  A'B'  in  minimum  time.  The  parameters  are  T  =  2,  a  —  10' 
and  /?  =  140°. 


Figure  8:  Optimal  motion  for  the  case  i  =  2,  a  =  10°  and  /3  =  156.35°.  Compared  to 
the  previous  example  /?  is  increased,  so  that  robot  A  has  just  enough  time  to  complete  the 
rotation. 


Figure  9;  The  case  L  -  2,  a  =  10°  and  /5  =  170°.  Robot  A  does  not  have  sufficient  time  to 
complete  the  rotation.  The  goal  position  A'B'  is  shown  in  dashed  line. 


2.3  A  Special  Case 

Consider  a  special  case  a  +  P  =  180°,  where  0  <  a  <  /3  <  180°.  As  is  shown  in  Figure  10, 

let  0  be  the  intersection  of  the  extensions  of  AB  and  A'B'.  Let  ^  =  \OB\  and  7  =  /.BOB' . 

Then  AB  and  A'B'  are  symmetrical  about  the  line  that  bisects  the  angle  7. 

Since  in  this  case  . 

a  =  90°  -  ^7,  (12) 

/3  =  90°  +  i7,  (13) 

and 

i  =  2^  sin  7/2,  (14) 

Eq.  11  can  be  rewritten  as 

tan(45°  +  |)  <  tan(45°  -  (15) 


Using  the  relations 


tan  “ 
2 


1  “  cos  X 


1  +  cos  X 


(16) 


and 

cos(90''  ±  a;)  =  qp  sin  x,  (17) 

Eq.  15  can  be  simplified  to 

1  +  sin  7/2  ^  ^4$  sin 7/2^ 

1  —  sin  7  /  2  ■“ 

Figure  11  is  the  curve  of  7  versus  ^  for  the  equality  g4^sin7/2^ 

The  region  below  the  curve  represents  the  combinations  of  ^  and  7  for  which  the  method 
in  Subsection  2.1  is  applicable  and  generates  a  motion  that  uses  optimal  time  L/u,  where 
L  =  \BB^\,  In  particular,  the  case  ^  =  0.5  is  a  pure  rotation  around  the  mid-point  of  AB, 


figure  12:  Optimal  motion  for  AB  to  make  an  angle  change  around  A  by  120“,  i.e.,  ^  =  1 
and  7  =  146.48°.  Robot  A  returns  to  its  original  position  at  the  end  of  the  motion. 


Figure  13:  Optimal  motion  for  ^  =  1  and  7  =  146.48®. 

for  which  7  =  0,  implying  that  the  method  is  not  applicable.  The  case  ^  =  1  corresponds 
to  A  =  A' ,  or  a  “rotation”  of  AB  around  A,  and  the  method  of  this  section  (in  which  B 
moves  straight  to  B'  at  speed  u)  can  be  used  for  the  values  of  7  iu  the  range  between  0  and 
146.48°.  As  ^  increases,  the  largest  possible  value  of  7  approaches  180°.  By  Theorem  1, 
this  limit  (7  =  180°,  hence  a  =  0  and  /3  =  180°)  can  never  be  reached. 

Figure  12  shows  the  optimal  motion  of  AB  for  ^  =  1  and  7  =  120°.  In  this  case,  robot 
A  completes  the  necessary  rotation  before  B  reaches  the  destination,  and  then  moves  to  A 
(which  coincides  with  its  initial  position  since  ^  =  1)  along  a  straight  line. 

In  Figure  13  we  increase  7  to  146.48°  while  keeping  =  1.  As  we  mentioned  above,  this 
is  a  critical  case  for  ^  =  1,  and  thus  A  completes  its  rotation  exactly  when  B  reaches  B'. 

Figure  14  shows  the  movements  of  the  robots  using  the  same  strategy  for  the  case  ^  =  1 
and  7  =  160°  (>  146.48°).  In  this  case  robot  A  does  not  have  enough  time  to  complete  the 
rotation,  and  in  fact,  the  last  position  of  A  shown  in  Figure  14  is  not  its  final  position. 


12 


Figure  14:  The  case  C  =  1  and  7  =  160^.  Robot  A  cannot  complete  the  rotation.  The  goal 
position  A'B'  is  shown  in  dashed  line. 

2.4  A  General  Property  of  Optimal  Motion 

As  we  stated  before,  we  assume  that  at  any  moment  during  the  motion,  the  speed  of  each 
robot  is  either  a  given  constant  n  or  0.  So  we  allow  a  robot  to  remain  stationary  while  the 
other  robots  rotates  around  it  along  an  arc.  We  now  prove  that  both  robots  must  always 
move  at  speed  v  in  any  optimal  motion. 

Theorem  2  In  any  optimal  motion^  both  robots  move  at  speed  v  at  any  moment 

Proof  Suppose  in  an  optimal  motion,  robot  A  remains  stationary  over  an  interval  of  time, 
and  thus  robot  B  rotates  around  robot  A  along  an  arc.  (Clearly,  if  neither  robot  moves  over 
an  interval,  then  the  motion  is  not  optimal.)  See  Figure  15.  We  can  choose  the  interval  to 
be  sufficiently  small,  so  that  B  rotates  around  A  for  an  angle  7  less  than  146.48^.  Then 
the  motion  in  this  interval  is  exactly  the  one  discussed  in  Subsection  2.3,  with  ^  =  1  and 
7  <  146.48''.  So  the  optimal  motion  in  this  interval  is  the  one  in  which  B  moves  straight 
to  its  destination  while  A  moves  along  a  circular  path.  Clearly  this  motion  takes  less  time 
than  the  original  one.  This  is  a  contradiction.  □ 


3  The  Variational  Method 

As  we  have  seen  in  Section-  2,  if  Eq.  11  is  satisfied  then  the  best  strategy  is  to  move  the 
robot  B  further  away  from  its  destination  along  a  straight  line,  and  rotate  robot  A  around 
it.  On  the  other  hand,  to  move  optimally  when  Eq.  11  is  not  satisfied,  intuitively  robot  B 
will  have  to  move  along  a  curve.  This  wiU  yield  some  extra  time  for  robot  A  to  complete 
the  necessary  rotation  around  S. 

In  this  section  we  consider  the  case  when  Eq.  11  is  not  satisfied,  and  discuss  a  method 
for  selecting  an  optimal  path  for  B  (and  hence  an  optimal  motion  for  A  and  S).  The 
method  we  use  is  known  as  variational  calculus,  a  branch  of  functional  analysis.  In  the  next 
subsection,  we  give  an  outline  of  the  method. 
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Figure  15:  Robot  £  rotates  around  robot  A  that  remains  stationary  during  the  motion. 
The  motion  is  not  optimal. 

3.1  Variational  Calculus 

Different  from  ordinary  functions,  a  functional  is  a  quantity  which  depends  on  the  entire 
course  of  one  or  more  functions  [2].  In  other  words,  the  domain  of  a  functional  is  a  set 
of  functions  rather  than  a  region  of  a  coordinate  space.  For  example,  in  our  study  of  the 
motion  of  the  two  robots,  the  path  of  robot  B  can  be  described  by  a  function,  and  the 
length  of  the  path  is  a  functional  which  is  determined  by  the  form  of  the  path. 

Variational  calculus  deals  with  the  extrema  of  a  functional  [5].  By  applying  variational 
calculus,  one  can  find  the  minima  or  maxima  of  a  functional,  which  in  turn  determines 
the  form  of  the  function  that  produces  such  extreme  values.  To  find  the  extrema  of  a 
functional,  one  first  identifies  independent  variables  of  the  functional  which  are  functions 
or  derivatives  of  functions.  A  functional  has  the  property  that  it  is  invariant  under  the  first 
order  change  of  its  variables  [5].  This  property  leads  to  a  set  of  differential  equations  known 
as  the  Euler  equations.  By  solving  the  Euler  equations,  the  functions  that  maximize  the 
functional  can  be  found.  Often,  the  solution  is  associated  with  specific  boundary  conditions 
of  these  functions. 

A  typical  example  illustrating  an  application  of  variational  calculus  is  finding  the  shortest 
path  between  two  points  in  a  plane.  As  we  know  the  solution  is  a  straight  line,  which  is 
indeed  the  solution  to  the  Euler  equation.  For  our  present  problem,  the  point  designated  by 
robot  B  cannot  move  arbitrarily.  Rather,  it  must  move  in  such  a  way  that  the  distance  from 
robot  A  to  robot  B  remains  constant.  Subsidiary  conditions  like  this  are  caRed  constraints 
and  can  be  handled  systematically  by  using  the  notion  of  Lagrange  multiplier  [2,  5].  The 
method  we  use  in  this  section  that  involves  Lagrange  multiplier  and  Euler  equations  is  called 
the  Euler-Lagrange  formulation. 

3.2  The  Coordinate  System 

We  set  up  a  Cartesian  coordinate  system  with  reference  to  the  initial  and  final  positions  of 
the  robots.  A,  B,  and  A',  B'  with  \BB'\  >  \AA'\.  The  a;-axis  is  chosen  to  be  along  BB'  with 
origin  at  B,  and  the  t/-axis  is  perpendicular  to  BB'  as  is  shown  in  Figure  16.  Under  this 
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Figure  16:  The  setup  of  the  Cartesian  coordinate  system  with  reference  to  the  initial  and 
final  positions  of  the  robots. 


coordinate  system,  B'  is  at  (L,  0)  with  L  =  and  a  and  /?,  respectively,  are  the  angles 

that  segments  AB  and  A' B'  make  with  the  x-axis.  We  denote  by  6  the  angle  between  AB 
and  the  x-axis  during  the  motion.  First,  we  give  a  general  property  any  optimal  motion  of 
the  two  robots. 

Lemma  2  In  any  optimal  motion,  6  changes  monotonically. 

Proof  K  0  does  not  change  monotonically,  then  there  must  be  three  positions  of  the  segment 
(occurring  in  this  order)  such  that  the  first  and  the  third  have  an  identical  inclination 
different  from  that  of  the  second.  Then  the  motion  can  be  shortened  by  replacing  the 
portion  between  the  first  and  the  third  by  a  pure  translation  (see  Figure  17).  □ 

The  property  of  optimal  motion  given  in  Lemma  2  applies  also  to  the  case  considered 
in  Section  2. 

By  Lemma  2,  during  any  optional  motion  either  0  >  0  (segment  AB  rotates  counter¬ 
clockwise  about  B),  OT  9  <  0  (segment  AB  rotates  clockwise  about  B).  The  overall  optimal 
motion  is  one  of  the  respective  optimal  motions  for  the  two  cases.  To  find  an  optimal  motion 
for  the  first  case,  we  take  a  and  so  that  a  <  /3  <  a  +  360°,  and  for  the  second  case,  we 
take  a -360°  <  /3  <  a.  In  the  rest  of  this  section  we  only  discuss  the  case  a  <  P  <  0-1-360°. 
The  discussion  for  the  other  case  is  similar  and  is  omitted. 

Lemma  2  does  not  state  that  the  change  of  6  be  strictly  monotonous.  Indeed,  it  is 
possible  that  an  optimal  motion  contains  pure  translation  (see,  for  instance.  Figure  12). 
However,  that  is  no  longer  possible  for  the  case  considered  in  this  section,  as  the  next 
lemma  states. 
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Figure  17:  Illustration  showing  the  situation  considered  in  the  proof  of  Lemma  2.  The 
trajectories  shown  in  dashed  lines  are  optimal.  The  intermediate  position  of  the  segment 
with  different  inclination  should  be  avoided. 

Lemma  3  If  Eq.  11  is  not  satisfied,  then  9  changes  strictly  monotonously  in  any  optimal 
motion. 

Proof  We  only  give  an  outline.  By  Lemma  2,  suppose  0  >  0  during  the  given  optimal 
motion.  (The  case  0  <  0  is  similar  and  is  omitted.)  Since  Eq.  11  is  not  satisfied,  there  is  a 
section  of  the  motion  in  which  ^  >  0,  and  the  trajectory  of  B  cannot  be  a  single  straight 
line.  Suppose  there  are  sections  of  the  motion  in  which  0  =  0.  In  these  sections  the  robots 
simply  travel  along  parallel  straight  lines  (rather  than  parallel  curves),  since  otherwise  the 
motion  cannot  be  optimal. 

Consider  the  portion  of  the  trajectory  of  B  where  a  section,  say  s,  with  0  >  0  meets 
a  section,  say  s',  with  0  =  0.  We  may  tissume  s  precedes  s'.  (Otherwise  we  consider  the 
reversal  of  the  given  motion.  Clearly,  the  reversal  of  any  optimal  motion  from  AB  to  A'B' 
is  an  optimal  motion  from  A'B'  to  AB.')  Section  s  may  be  a  curve,  but  s'  is  a  straight  line 
segment.  See  Figure  18.  Assume  either  s'  is  a  curve,  or  s  and  s'  meet  at  an  angle.  Suppose 
we  replace,  by  a  straight  line  segment,  an  arbitrary  small  portion  of  ss'  including  the  point 
where  s  and  s'  meet.  Then  travel  time  of  B  is  reduced,  but  as  a  side  effect,  the  increase  of 
0  achieved  in  s  may  be  reduced  by  an  arbitrary  small  amount.  This  wiH  produce  an  extra 
increase  of  0  that  needs  to  be  handled  in  section  s'.  However,  since  this  extra  increase  can 
be  made  arbitrarily  small,  section  s'  can  absorb  it  readily,  reducing  the  overall  time  needed 
for  the  motion.  This  is  a  contradiction  to  the  assumption  that  the  given  motion  is  optimal. 

Suppose  that  s'  is  a  straight  line  segment,  and  s  and  s'  together  form  a  longer  straight 
line  segment.  Then  since  the  trajectory  of  B  cannot  be  a  single  line  segment,  the  segment 
formed  by  merging  adjacent  sections  must  eventually  meet  a  section  with  0  >  0  that  is 
either  a  curve  or  that  forms  a  corner  with  the  segment.  Then  the  argument  given  in  the 
previous  paragraph  can  be  applied.  This  completes  the  proof.  □ 
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s 

Figure  18:  Illustration  for  the  proof  of  Lemma  3.  The  dashed  line  denotes  a  shortcut. 


3.3  Motion  Constraints 

To  obtain  the  optimal  path  for  the  robots,  we  need  to  minimize  the  length  of  the  trajectory 
of  B  (or  .4)  from  its  initial  position  to  its  final  position.  If  we  denote  by  (a:,  y)  the  coordinate 
of  B  during  the  motion,  then  the  length  element  of  the  trajectory  of  B  can  be  written  as 


+  y^dt  (19) 

where  the  dot  on  top  of  x  and  y  denotes  differentiation  with  respect  to  time  t.  Integrating 
Eq.  19  over  time  gives  the  length  of  the  trajectory  of  B  which  is  the  quantity  to  be  minimized. 
The  resulting  integral  is  a  functional  with  x  and  y  as  variables.  In  this  section  we  will  discuss 
the  constraints  that  must  be  met  by  the  optimization  procedure. 

There  are  two  constraints  for  the  motion  of  robots  A  and  B.  First,  the  distance  between 
them  must  remain  constant,  \AB\  =  1,  during  the  motion.  The  second  constraint  is  that  by 
Theorem  2,  both  robots  must  move  at  constant  speed  v  at  any  moment.  We  now  find  the 
consequences  of  these  constraints.  Since  B  moves  along  a  curve,  we  denote  by  the  angle 
between  the  x-a.xis  and  the  direction  of  the  velocity  of  B.  See  Figure  19.  Recall  that  9  is 
the  angle  between  the  a:-2ixis  and  BA.  From  the  definition  of  (f> 

^  —  tand>.  (20) 


Relative  to  robot  B,  robot  A  rotates  with  angular  speed  u,  where 
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Figure  19:  The  definitions  of  9  and  (f>.  The  arrow  represents  the  velocity  of  robot  B. 

The  angle  between  the  velocity  of  B  and  the  velocity  of  A  due  to  rotation  around  B  is 
90°  +  9  —  ((>.  Therefore  V,  the  resultant  speed  of  A,  is  given  by 

A  —  2u;'usin(0  —  (f>).  (22) 

Equation  22  is  a  consequence  of  the  first  constraint  on  the  motion  of  the  robots.  For  the 
second  constraint,  we  have  V  =  v.  ll  then  follows  from  Eq.  22  that  for  a;  >  0, 

uj  =  2v  sin(0  —  4) 

=  2u  sin  0  cos  <^  —  2t;  cos  ^  sin  </>.  (23) 

It  should  be  noted  that  the  case  with  w  =  0  also  satisfies  the  motion  constraint.  However, 
by  Lemma  3,  the  case  with  w  =  0  will  not  be  present  in  an  optimal  solution. 

From  the  definition  of  </>,  we  represent  the  components  of  the  velocity  of  B  in  terms  of 


V  and  4  as 

dx  , 

dt  ^ 

(24) 

and 

■  A. 

—  =  u  sm  4- 
dt 

(25) 

Substituting  Eq.  24  and  Eq.  25  into  Eq.  23,  we  have 

0  —  2i  sin  0  +  2y  cos  ^  =  0 

(26) 

where  the  dot  over  x,  y  and  9  represents  derivative  with  respect  to  time.  Equation  26 
describes  the  constraints  on  the  optimal  motion. 

Figure  20  gives  an  illustration  of  the  constraints.  As  shown  in  the  figure,  under  the 
constraints,  the  components  of  the  velocities  of  the  robots  parallel  to  AB  must  be  equal  so 
that  there  is  no  relative  motion  along  the  line  joining  A  and  B.  In  addition,  the  components 
of  the  velocities  of  the  robots  perpendicular  to  AB  are  equal  in  magnitude  and  opposite  in 
direction  to  each  other.  As  a  result,  the  direction  of  the  center  of  mass  motion  of  the  robots 
is  always  aligned  with  the  line  segment  AB. 


18 


Figure  20:  Illustration  of  the  motion  constraints.  The  arrows  represent  the  velocities  of  the 
robots.  The  velocities  have  identical  magnitude,  and  their  angles  from  the  segment  BA  are 
also  identical. 


3.4  Euler-Lagrange  Formulation 

We  now  apply  the  variational  method  to  find  the  differential  equations  that  the  optimal 
path  obeys. 

According  to  the  results  in  Subsection  3.3,  our  task  is  to  minimize  the  integral 


F  =  J 

(27) 

subject  to  the  constraint 

9  —  2x  sin  6  -\-2y  cos  9  =  0 

(28) 

and  the  boundary  conditions 

f  x(0)  =  0 

\  y(0)  =  0 

(29) 

o 

1!  II 

(30) 

and 

9(t)  -  9(0)  =  /3-a. 

(31) 

From  the  theory  of  functional  variations,  we  know  that  minimizing  the  integral  given  by 
Eq.  27  with  the  constraint  Eq.  28  is  equivalent  to  minimizing  the  following  expression  [2] 

f  L(x,y,9,9) 

Jo 

(32) 

where  _ 

L{x,y,9,e)  =  +  y^  +  A(i)(^  -  2xsm0  +  2^cos^).  (33) 
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In  Eq.  33,  X{t)  is  so  called  the  Lagrange  multiplier  and  it  is  a  function  of  time  [2].  Mini¬ 
mization  of  Eq.  32  is  also  required  to  satisfy  the  boundary  conditions  Eq.  29,  Eq.  30  and 
Eq.  31. 

The  application  of  the  Euler-Lagrange  formulation  yields  the  following  set  of  equations 

dL  d  dL  „ 

(35) 

(36) 

(37) 


dx  dt  dx 
n  _  ^  _  Q 

dy  dt  dy 

^  - 0 
89  dt  89 


In  addition,  the  optimal  path  must  satisfy  the  constraint  Eq.  28  and 

x"^  +  y^  =  v^. 

It  should  be  noted  that  among  Eq.  34,  Eq.  35  and  Eq.  36,  only  two  equations  are  independent 
[8].  For  convenience,  we  will  use  only  Eq.  34  and  Eq.  35,  together  with  Eq.  28  and  Eq.  37. 

3.5  The  Solution 

Since  L  is  not  an  explicit  function  of  x  and  y,  the  first  term  on  the  left  hand  side  of  Eq.  34 
and  Eq.  35  is  zero.  The  second  term  of  the  Eq.  34  and  Eq.  35  gives 


£ 

dt 

£ 

dt 


+  y 


=  —  2A(t)  sin0 


=  -b  2A(t)  cos  9 


\/iP‘  -b 

Integrating  both  sides  of  Eq.  38  and  Eq.  39,  we  have 

2A(t)  sin0  =  a 


=  0. 


yjx^  +  iP' 


y 


-b  2A(t)  cos  9  =  b 


where  a  and  b  are  constant.  Applying  Eq.  37  we  have 

—  —  2A(t)  sin0  =  a 


y 


-b  2A(t)  cosO  =  b. 


(38) 

(39) 

(40) 

(41) 

(42) 

(43) 


To  eliminate  the  unknown  function  A(^),  we  multiply  Eq.  42  and  Eq.  43  by  cos  6  and  sin 
respectively.  Adding  the  results,  we  obtain 

X  cos  0  4-  y  sin  0  =  av  cos  6  +  bv  sin  6.  (44) 

Solving  for  x  and  y  from  Eq.  44  and  the  constraint,  Eq.  28,  we  have 

e 


X  =  -  sin  ^  +  an  cos"^  6  +  bv  sin  9  cos  9 

V  =  —  cos  9  av  cos  0  sin  0  -b  bv  sin^  9. 
"  2 


(45) 

(46) 
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Substituting  these  expressions  for  x  and  y  into  Eq.  37,  and  simplifying  the  result,  we  have 

- \-  (avcosO  +  bv  sin  6)‘^  =  (47) 

4 

In  Eq.  45,  Eq.  46  and  Eq.  47,  a  and  b  are  parameters  to  be  determined  from  the  boundary 
conditions.  We  can  replace  a  and  b  by  two  equivalent  parameters  c  and  S  defined  by 

c  =  \/a^  +  6^  (48) 


and  _ 

tan  <5  =  -.  (49) 

b 

With  the  newly  defined  constants,  Eq.  45,  Eq.  46  and  Eq.  47  can  be  written  as 


i  =  -  sin  ^  +  cu  cos  6  sm{6  +  6) 
6 

y  —  — -  COS  9  +  cvsin  0sm(0  +  6) 
9  =  ‘i.vyjl  —  c?  sin^(0  +  ^). 


(50) 

(51) 

(52) 


Eq.  50,  Eq.  51  and  Eq.  52  are  the  basic  result  of  this  section.  From  Eq.  50  and  Eq.  51,  we 
can  find  the  instantaneous  velocity  of  robot  B,  hence  its  trajectory.  Equation  52  gives  the 
angular  speed  of  robot  A  around  robot  B. 

To  determine  the  parameters  c  and  we  divide  both  sides  of  Eq.  50  and  Eq.  51  by  9, 
using  Eq.  52.  The  two  equations  then  become 


dx 

d9 

d9 


1  ccos0sin(0  +  5) 

-  sin  6>  +  — , 

^  2\J\  -  s\v?{9 6) 

1  ^  csin^  sin(^  +  <5) 

—  cos  9  H - ,  ■ . 

2  2Jl-cHm'^{9  +  6) 


(53) 

(54) 


Integrating  both  sides  of  Eq.  53  and  Eq.  54  from  9  =  a  to  9  —  v/e  have 


I  r  c  cos 


c  cos0sin(^  +  5) 


-.d9  =  L 


0“  sin' 


>(0  +  5) 


(55) 


1 

2 


L 


^  c 

cos  9d6  +  - 


sin  9  sin(0  +  5) 
sin^(0  +  5) 


=  0. 


(56) 


To  obtain  Eq.  55  and  Eq.  56,  we  have  used  the  boundary  conditions  given  by  Eq.  29,  Eq.  30 
and  Eq.  31.  The  two  equations  are  sufficient  for  determining  the  two  constants  c  and  6. 
From  these  two  constants  and  Eq.  50,  Eq.  51  and  Eq.  52  we  can  find  the  path  of  the  optimal 
motion. 
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3.6  Results  in  Terms  of  Elliptic  Integrals 

It  is  possible  to  express  our  results  in  terms  of  the  Legendre  elliptic  integrals  [7]  defined  as 


de 

\/l  —  sin^  9 


(57) 


E{(l),k)=  [  sin^  0d6.  (58) 

Jo 

F{(l>,  k)  and  -B(^,  k)  are  known  as  the  Legendre  elliptic  integral  of  the  first  and  second  kind, 
respectively.  Using  these  definitions,  Eq.  55  and  Eq.  56  can  be  written  as 


^(coso  —  cos/3)  H — - —  \J\  —  sin^(Q:  6)  —  \J  1  —  sin^(/3  +  5) 


[E(/3  +  5,  c)  -  F{a  +  ^,  c)  -  E(/3  +  6,  c)  +  F{a  +  S,  c)]  =  L 


(59) 


and 


i(sina-sin/3)-  ^  [^1  -  sin2(a  +  5)  -  ^1  -  +  6) 

iuC 


cos  <5 


H - [F{f3  +  5,  c)  —  F{a  +  S,c)  —  E{f}  +  <5,  c)  +  E{a  +  c)]  —  0. 

2c 


(60) 


Once  given  a,  /3  and  L,  these  two  equations  can  be  solved  numerically  to  yield  c  and  6.  We 
can  then  use  the  values  to  produce  the  optimal  path  from  Eq.  50,  Eq.  51  and  Eq.  52. 

We  can  also  calculate  t,  the  time  span  of  the  optimal  motion,  using  Eq.  52  as  follows. 


t 


L 


^  dt 

—de 

de 


1  /•/? _ de 


(61) 


In  terms  of  elliptic  integral  we  then  have 

t  =  ^[F{/3  +  S,c)-F{a  +  S,c)].  (62) 

Zv 

The  notation  of  elliptic  integrals  not  only  makes  our  expressions  look  more  compact, 
it  also  allows  us  to  apply  available  algorithms  for  calculating  F{(f>,k)  and  F{(t>,k).  The 
algorithms  make  use  of  the  properties  of  the  elliptic  integrals,  and  converge  very  fast  [12]. 
We  used  these  algorithms  to  compute  optimal  motion  for  the  examples  given  in  the  next 
section. 

Summarizing  the  discussion  of  this  section,  we  obtain: 

Theorem  3  Suppose  that  Fq.  11  is  not  satisfied.  An  optimal  motion  in  which  segment  AB 
rotates  about  B  counterclockwise  can  be  obtained  from  Fq.  50,  Eq.  51  and  Fq.  52,  using  c 
and  S  satisfying  Fq.  59  and  Fq.  60.  The  time  needed  to  execute  the  motion  is  obtained  from 
Fq.  62. 
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Figure  21:  Optimal  motion  in  which  segment  AB  turns  around  by  180°.  Parameters  are 
i  =  2,  a  =  0  and  /?  =  180°. 


3.7  Examples 

Figure  21  shows  an  optimal  motion  obtained  by  the  method  presented  in  this  section,  for 
the  case  when  segment  AB  must  be  turned  around  by  180°  about  A.  The  parameters  for 
this  instance  are  i  =  2,  o;  =  0  and  =  180°,  and  the  method  in  Subsection  2.1  is  not 
applicable.  This  motion  has  been  obtained  as  follows. 

We  first  substitute  the  value  of  L,  a  and  /3  into  Eq.  59  and  Eq.  60.  Solving  the  two 
equations  for  c  and  S  numerically,  we  obtain  S  =  90°  and  c  =  0.836.  Using  these  values 
and  Eq.  50,  Eq.  51  and  Eq.  52,  we  generate  the  trajectories  of  the  two  robots,  shown  in 
Figure  21.  From  Eq.  62  the  length  of  the  trajectory  of  each  robot  is  found  to  be  2.074. 

Figure  22  shows  a  suboptimal  motion  to  the  same  instance  obtained  by  applying  the 
method  of  Section  2  twice.  The  motion  consists  of  two  phases.  In  the  first  phase,  the  angle 
6  changes  by  90°  while  B  moves  along  a  straight  line  to  an  intermediate  point  C.  At  this 
moment  the  segment  is  vertical.  Point  C  is  chosen  so  that  it  is  symmetrical  with  respect 
to  B  and  S',  and  is  as  close  to  the  segment  BB'  as  possible  while  keeping  the  method  of 
Section  2  appUcable.  That  is,  if  we  let  L'  =  \BC\,  a'  =  LABC  and  /?'  =  180°  -  LACB, 
then  we  have,  from  Eq.  11, 

tan(/372)  =  tz,n{a' /2)e^^  .  (63) 

With  the  additional  relations 

13'  =  90°  +  a'  (64) 


and 


(65) 


we  obtain  ZABC=  19.48°,  which  specifies  the  location  of  point  C.  The  second  phase  is 
symmetric  to  the  first  case.  That  is,  robot  B  that  is  currently  at  point  C  moves  along  a 
straight  line  to  B' .  The  length  of  the  trajectory  of  each  robot  in  this  suboptimal  motion  is 
2.122,  slightly  larger  than  that  of  the  optimal  motion  given  above. 


Figure  22:  Sub-optimal  motion  for  the  instance  of  Figure  21  in  which  the  segment  turns 
around  by  180°. 


Figure  23:  Optimal  motion  for  i  =  1,  a  =  0°  and  /?  =  90°. 

The  next  example  is  for  T  =  1,  a  =  0°  and  (3  =  90°,  which  involves  a  rotation  of  90° 
and  translation.  Figure  23  shows  the  result  of  our  calculation.  The  length  of  the  trajectory 
of  each  robot  in  this  motion  is  approximately  1.1.  It  is  easy  to  see  that  the  solution  to 
the  TJlam  problem  mentioned  in  Section  1  (to  minimize  the  sum  of  the  lengths  of  total  the 
trajectories  of  A  and  B)  for  this  instance  is  to  move  A  and  B  straight  towards  A'  and  B\ 
respectively.  In  our  problem,  however,  B  cannot  move  straight  to  its  destination  at  speed 
V,  since  as  we  discussed  in  the  proof  of  Lemma  1,  such  a  move  does  not  allow  robot  A  to 
rotate. 

Compare  this  to  the  instance  shown  in  Figure  24,  which  involves  only  a  rotation  of  90° 
around  A.  The  optimal  motion  shown  in  Figure  24,  where  the  length  of  the  trajectory  of 
each  robot  is  ^/2,  has  been  obtained  by  the  method  of  Section  2,  since  Eq.  11  is  satisfied. 

We  conclude  with  two  more  examples.  Figure  25  shows  an  optimal  motion  for  the 
instance  of  Figure  9,  where  L  =  2,  a  =  10°  and  /3  =  170°.  Recall  that  the  method 
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Figure  24:  Optimal  motion  for  L  =  \/2?  ^  0  ~  135^  computed  by  the  method  of 

Section  2. 


Figure  25:  Optimal  motion  for  the  instance  of  Figure  9,  where  L  =  2,  a  =  10''  and  (5  -  170". 

of  Section  2  did  not  generate  an  optimal  motion.  The  last  example  is  the  case  i  =  2, 
a  “10"  and  /?  =  120".  Figure  26  shows  the  result  of  our  calculation. 

4  Conclusion 

We  considered  the  problem  of  computing  a  time-optimal  motion  of  two  robots  carrying  a 
ladder,  subject  to  the  constraint  that  at  any  moment  during  the  motion,  the  speed  of  each 
robot  is  either  a  given  constant  v,  or  0.  We  identified  an  inequality,  Eq.  11,  that  allows  us 
to  determine  whether  there  exists  an  optimal  motion  in  which  the  required  displacement  of 
the  ladder  is  completed  while  the  robot  further  away  from  its  destination  moves  straight 
to  its  destination  at  speed  v.  If  the  inequality  is  not  satisfied,  then  an  optimal  motion  is 
computed  using  variational  calculus. 

In  our  discussions,  a  robot  is  not  allowed  to  move  at  a  nonzero  speed  less  than  u.  Suppose 
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Figure 26:  Optimal  motion  for  L  =  2,  a  =  —10°  and  /?  —  120°. 


we  relax  this  condition  and  assume  that  each  robot  can  move  at  any  speed  not  exceeding 
V.  If  Eq.  11  is  satisfied,  then  the  motion  computed  in  Section  2  is  stiE  optimal  under  this 
new  assumption,  since  there  is  no  ”need”  for  the  robots  to  slow  down  to  achieve  an  optimal 
motion.  If  Eq.  11  is  not  satisfied,  however,  the  results  given  in  Section  3  based  on  variational 
calculus  cannot  be  appUed  directly.  To  understand  the  difficulty  in  the  analysis,  consider 
robots  A  and  B  moving  at  instantaneous  speeds  v'  and  v",  respectively,  during  an  optimal 
motion,  where  0  <  v,v'  <  v.  Here,  maxln',-!;"}  =  v  holds,  since  otherwise  we  can  reduce 
the  time  by  increasing  v'  and  v"  proportionally  until  one  reaches  v.  Imagine  that  we  draw, 
on  the  plane,  exactly  those  parts  of  the  trajectory  of  A  where  A  moves  at  speed  v,  plus 
those  parts  of  the  trajectory  of  B  where  B  moves  at  speed  v  but  A’s  speed  at  that  moment 
is  less  than  v.  Let  5  be  the  collection  of  the  curves  drawn  as  above.  Then  since  v  is  a 
constant,  the  total  time  needed  to  execute  the  motion  is  proportional  to  the  sum  of  the 
lengths  of  the  curves  in  5.  So,  finding  an  optimal  motion  is  equivalent  to  finding  such  S 
having  the  smallest  total  sum.  However,  since  either  of  A  and  B  can  be  the  faster  robot 
at  any  moment,  5  is  only  piecewise  continuous.  This  makes  the  analysis  using  variational 
calculus  difficult. 

Eor  future  research,  we  suggest  to  extend  our  work  to  the  case  in  which  (1)  the  robot 
can  move  at  any  speed  not  exceeding  a  given  constant,  (2)  other  kinematic  constraints,  such 
as  maximum  acceleration,  are  considered,  and  (3)  the  plane  is  occupied  with  obstacles. 
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